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© Method and apparatus for estimating incline and bank angles of a road surface 



© The present invention is directed to a method and apparatus for estimating incline and bank angles of a road 
surface upon which a front wheel drive vehicle is travelling. Each nondriven rear wheel (16) and (18) is equipped 
with a rotational speed sensor (22) and (24). The vehicle is further equipped with longitudinal (34) and lateral 
(32) accelerometers mounted to the vehicle chassis above the centerline of the rear axle (36). Outputs from the 
speed sensors and accelerometers are fed into a vehicle on-board controller (26) and utilized in computing the 
^ incline and bank angles of the road surface. Updated incline and bank angles are maintained in the controller's 
^ memory for access by various control systems to alter vehicle attributes for improved handling and operation. 
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The present invention relates to a method and apparatus for estimating the incline and bank angles of a 
road surface upon which a vehicle is travelling. 

Background of the Invention 

s 

Sophisticated vehicular control systems may desire to alter various operational attributes such as 
suspension, transmission shifting and anti-lock braking characteristics in the presence of varying driving 
conditions. Incline and bank angles of a road surface upon which the vehicle is travelling represent two such 
conditions. 

10 

Summary of the Invention 

The present invention is directed to a method and apparatus for estimating incline and bank angles of a 
road surface upon which a front wheel drive vehicle is travelling. In accordance with the present invention, 

75 each nondriven rear wheel is equipped with a rotational speed sensor. The vehicle is further equipped with 
longitudinal and lateral accelerometers mounted to the vehicle chassis above the centerline of the rear axle. 
Outputs from the speed sensors and accelerometers are fed into a vehicle on-board controller and utilized 
by the controller in computing the incline and bank angles of the road surface. Incline and bank angle 
methods and apparatuses, in accordance with the present invention, are defined by the features specified in 

20 Claims 1, 6, 11 and 15. 

The present invention provides for estimation of the incline angle of a road surface by (i) computing a 
longitudinal acceleration as a function of the rotational speeds of the vehicle's tear wheels sensed by the 
speed sensors, (ii) determining a pitch angle of the vehicle as a function of the longitudinal acceleration 
sensed by the longitudinal accelerometer, and (iii) computing an estimated incline angle of the road surface 

26 as a function of the computed longitudinal acceleration, sensed longitudinal acceleration and the pitch 
angle. 

An embodiment may provide for determining a yaw rate of the vehicle as a function of the difference 
between the sensed rotational speeds of the rear wheels, and the distance between them. Incline angle 
estimation can, therefore, be inhibited if a change in yaw rate is greater than a predetermined threshold, 
30 indicative of angular acceleration. 

The present invention also provides for estimation of the bank angle of a road surface by (i) computing 
a longitudinal velocity as an average of the rotational speeds of the vehicle's rear wheels sensed by the 
speed sensors, (ii) determining a roll angle of the vehicle as a function of the lateral acceleration sensed by 
the longitudinal accelerometer, (iii) determining a yaw rate of the vehicle as a function of the difference 
35 between the sensed rotational speeds of the rear wheels, and the distance between them, and (iv) 
computing an estimated bank angle of the road surface as a function of the computed longitudinal velocity, 
the sensed lateral acceleration, the roll angle and the yaw rate. 

An embodiment may provide for inhibiting bank angle estimation if a change in yaw rate is greater than 
a predetermined threshold, indicative of angular acceleration. 
40 Updated incline and bank angles are maintained in the controller's memory for access by various 
control systems to alter vehicle attributes for improved handling and operation. 

Brief Description of the Drawings 

45 The present invention will be described, by way of example, with reference to the accompanying 
drawings, in which: 

FIG.1 is a schematic illustration of a vehicle equipped with the apparatus of the present invention; 
FIG. 2 is a schematic illustration of a vehicle travelling up an inclined road surface; 
RG. 3 is a flow diagram for an incline angle calculation routine implemented by a controller; 
so RG. 4 is a schematic illustration of a vehicle travelling along a banked road surface; and 
RG. 5 is a flow diagram for a bank angle calculation routine implemented by a controller. 

Detailed Description of the Preferred Embodiment 

55 RG. 1 is a schematic illustration of a vehicle equipped with the apparatus of the present invention. 
Referring to RG. 1, vehicle 10 includes front-driven steering wheels 12 and 14, nondriven nonsteering rear 
wheels 16 and 18, controller 26, speed sensors 22 and 24. and lateral and longitudinal accelerometers 32 
and 34, respectively. 
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Speed sensors 22 and 24 are responsive to the rotational speed of rear wheels 16 and 18, respectively. 
Outputs of the speed sensors 22 and 24 are fed into controller 26 via signal lines 28 and 30, respectively. 

Lateral accelerometer 32 is mounted to the vehicle chassis 10 above the centeriine of the rear axle 36 
and is responsive to vehicular acceleration normal to the longitudinal centeriine 20 of the vehicle. The 
5 output of the lateral accelerometer 32 is fed into controller 26 via signal line 38. 

Longitudinal accelerometer 34 is mounted to the vehicle chassis 10 above the centeriine of the rear axle 
36 and is responsive to vehicular acceleration parallel to the longitudinal centeriine 20 of the vehicle. The 
output of the longitudinal accelerometer 34 is fed into controller 26 via signal line 40. 

The controller 26 utilizes inputs received from the speed sensors 22 and 24 and acceferometers 32 and 
to 34 to compute the incline and bank angles of the road surface in accordance with computer routines 
contained within the controller 26. 

Updated incline and bank angles are maintained in memory within the controller 26 for access by 
various vehicle control systems to alter vehicle attributes for improved handling and operation. 

FIG. 2 is a schematic illustration of a vehicle 10 travelling up an inclined road surface 50 having an 
75 angle of incline 0|. The analysis and result are identical for a vehicle travelling down the same inclined road 
surface 50. The total angle of incline fl T of the vehicle 10 is equal to the incline angle 0| of the road surface 
50 plus the pitch angle d P of the vehicle 10. The pitch angle $ P of the vehicle 10 is the degree of 
longitudinal tilt of the vehicle 10 with respect to the road surface 50. It is computed as follows: 

20 $ P = PITCH STIFFNESS X SENSED LONGITUDINAL ACCELERATION (1) 

PITCH STIFFNESS is a constant term particular to a specific vehicle design. It is a function of such 
design parameters as vehicle size, weight distribution, wheel base and suspension. It represents the 
degrees of longitudinal tilt a vehicle 10 will experience for every unit of longitudinal acceleration equal to 9.8 

25 m/s 2 (or g). Note that g is an abbreviated form for earth's gravitational force at one atmosphere and is often 
used as a unit for acceleration. 

SENSED LONGITUDINAL ACCELERATION represents the longitudinal acceleration, in units of g, as 
sensed by the longitudinal accelerometer 34. The output of an accelerometer is a voltage signal having a 
magnitude varying in accordance with varying acceleration. The controller 26 of RG. 1 compares the 

30 voltage level of the longitudinal accelerometer 34 with a predetermined voltage level corresponding to an 
acceleration equal to g. In this way, the controller 26 arrives at an acceleration in units of g corresponding to 
the actual accelerometer voltage output. For example, an accelerometer output voltage level of 2 volts may 
correspond to an acceleration of 1 g. So an accelerometer with an output of 1 volt corresponds to an 
acceleration of 0.5 g, or 4.9 m/s 2 . 

36 By multiplying PITCH STIFFNESS (degree/g) by the SENSED LONGITUDINAL ACCELERATION (g), a 
pitch angle 0 P in degrees is obtained. 

Factors contributing to the sensed longitudinal acceleration are as follows: 

SENSED LONGITUDINAL ACCELERATION = (YAW RATE X LATERAL VELOCITY) + COMPUTED 
40 LONGITUDINAL ACCELERATION + G[SIN (fl, + 0 P )] + BIASlqnq (2) 

YAW RATE is the rate of vehicle turning in degrees per second. It is computed as follows: 

46 LEFT REAR WHEEL SPEED - RIGHT REAR WHEEL SPEED 

YAW RATE = (3) 

DISTANCE BETWEEN THE REAR WHEELS 

For a forward travelling vehicle, a positive yaw rate represents a clockwise vehicle turning maneuver, while 

so a negative yaw rate represents a counterclockwise vehicle turning maneuver. 

LATERAL VELOCITY is the speed by which the vehicle is travelling laterally. It exists during transient 
conditions such as varying yaw rates or angular accelerations. However, incline angle computation is not 
performed during varying yaw rates to insure computational accuracy. Therefore, LATERAL VELOCITY is 
essentially zero and the first term of equation (2) is negligible. 

55 Each of the two rear wheels 16 and 18 have rotational speed sensors 22 and 24, respectively. The 
output of the two sensors are utilized by the controller 26 to compute the average speed of the two rear 
wheels, thereby achieving a longitudinal velocity. Longitudinal velocity is recalculated each scan of the 
controller 26. The change in longitudinal velocity from one scan to the next is divided by the scan rate of 
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the controller to arrive at the COMPUTED LONGITUDINAL ACCELERATION term of equation (2). 

BIASlong is a known constant voltage offset corresponding to the amount of offset of the longitudinal 
accelerometer 34 from a perpendicular to the vehicle plane 52. An accelerometer which is offset will result 
in a constant voltage bias which must be accounted for in computing acceleration, 
s Recall that the surface incline angle 3\ is the desired result. Eliminating the first term from equation (2) 
and sofc/ing for o, provides the following equation used by controller 26 to compute ${ 

*i = SIN" 1 [SENSED LONGITUDINAL ACCELERATION - COMPUTED LONGITUDINAL 

ACCELERATION - BIASlqnq] - 0 P (4) 

10 

Since all quantities in equation (4) are known, the incline angle 0j of the road surface 50 can be computed. 

FIG. 3 is a flow diagram for an incline angle calculation routine contained within and performed by 
controller 26 for implementation of the present invention. The routine is performed each scan of the 
controller. Referring to FIG. 3, step 60, input signals from the two rear wheel speed sensors 22 and 24 and 

is the longitudinal accelerometer 34 are read via signal lines 28, 30 and 40, respectively. 

At step 62, the vehicle yaw rate is computed in accordance with equation (3) based upon the newty 
read inputs of step 60. The newly computed yaw rate of step 62 is compared in step 64 with the previously 
calculated yaw rate of step 62 stored in memory during the last scan of the controller 26. If the difference 
between the two yaw rates is greater than a predetermined threshold, the controller 26 exits the routine. 

20 This ensures that the incline angle computation is not performed during angular accelerations which could 
affect the accuracy of the computation. Prior to exiting, the newly computed yaw rate of step 62 is stored 
into memory at step 70 for reference during the next scan of the controller 26. 

At step 66, the controller 26 computes a longitudinal velocity in accordance with the average rear wheel 
speeds. In step 68, a vehicle longitudinal acceleration is computed as a change in the longitudinal velocity 

25 of step 66 from the previously computed longitudinal velocity of step 66 stored in memory during the last 
scan of the controller 26, divided by the scan rate of the controller 26. 

At step 72, the controller 26 identifies the vehicle longitudinal acceleration sensed by the longitudinal 
accelerometer 34 corresponding to the input read in step 60. At step 74, the vehicle pitch stiffness is 
multiplied by the sensed longitudinal acceleration of step 72 to arrive at a vehicle pitch angle 0 P . At step 76, 

30 the incline angle 6 ( of the road surface 50 is computed in accordance with equation (4), and filtered by 
methods well known to those skilled in the art to eliminate noise. 

The incline angle Q\ is then stored in memory at step 78 for use by various vehicle control systems to 
improve handling and operation. Prior to exiting, the computed yaw rate of step 62 and longitudinal velocity 
of step 66 are stored in memory in step 70 for reference during the next scan of the controller 26. 

35 FIG. 4 is a schematic illustration of a vehicle 10 travelling along a banked road surface 50 having an 
angle of bank 0b- The total angle of bank $j of the vehicle 10 is equal to the bank angle 6 B of the road 
surface 50 plus the roll angle e R of the vehicle 10. The roll angle 6 R of the vehicle 10 is the degree of lateral 
tilt of the vehicle 10 with respect to the road surface 50. It is computed as follows: 

40 Br = ROLL STIFFNESS X SENSED LATERAL ACCELERATION (5) 

ROLL STIFFNESS is a constant term particular to a specific vehicle design. It is a function of such 
design parameters as vehicle size, weight distribution, wheel base and suspension. It represents the 
degrees of lateral tilt a vehicle 10 will experience for every unit of lateral acceleration equal to 9.8 m/s 2 (or 
45 g). Recall that g is an abbreviated form for earth's gravitational force at one atmosphere and is often used 
as a unit for acceleration. 

SENSED LATERAL ACCELERATION represents the lateral acceleration, in units of g, as sensed by the 
lateral accelerometer 32. By multiplying roll STIFFNESS (degree/g) by the SENSED LATERAL ACCELERA- 
TION (g), a roll angle e R in degrees is obtained, 
so Factors contributing to the sensed lateral acceleration are as follows; 

SENSED LATERAL ACCELERATION = (YAW RATE X COMPUTED LONGITUDINAL VELOCITY) + D- 

(LATERAL VELOCITY)/DT + G[SIN(0 S + 0 P )] + BIASlat (6) 

66 YAW RATE is the rate of vehicle turning in degrees per second. It is computed as follows: 
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LEFT REAR WHEEL SPEED - RIGHT REAR WHEEL SPEED 

YAW RATE = - (7) 

DISTANCE BETWEEN THE REAR WHEELS 

S 

Each=of the two rear wheels 16 and 16 have rotational speed sensors 22 and 24, respectively. The 
output of the two sensors are utilized by the controller 26 to compute the average speed of the two rear 
wheels, thereby achieving a longitudinal velocity. Longitudinal velocity is recalculated each scan of the 
controller 26. 

70 LATERAL VELOCITY is the speed by which the vehicle is travelling laterally, ft exists during transient 
conditions such as varying yaw rates or angular accelerations. However, incline angle computation is not 
performed during varying yaw rates to insure computational accuracy. Therefore, D(LATERAL VELOCITY)- 
DT is essentially zero and the second term of equation (6) is negligible. 

BIASlat is a known constant voltage offset corresponding to the degree of offset of the lateral 
75 accelerometer 32 from a perpendicular to the vehicle plane 52. An accelerometer which is offset will result 
in a constant voltage bias which must be accounted for in computing acceleration. 

Recall that the surface bank angle d B is the desired result Eliminating the second term from equation 
(6) and solving for 6 B provides the following equation used by controller 26 to compute 0* 

20 $ B = SIN" 1 [SENSED LATERAL ACCELERATION - (YAW RATE X COMPUTED LONGITUDINAL 

VELOCrTY) - BIASlaj] - Or (8) 

Since all quantities in equation (8) are known, the bank angle 6 B of the road surface 50 can be 
computed. 

25 FIG. 5 is a flow diagram for a bank angle calculation routine contained within and performed by 
controller 26 for implementation of the present invention. The routine is performed each scan of the 
controller. Referring to FIG. 5, step 60, input signals from the two rear wheel speed sensors 22 and 24 and 
the lateral accelerometer 32 are read via signal lines 28, 30 and 38, respectively. 

At step 82, the vehicle yaw rate is computed in accordance with equation (7) based upon the newly 

so read inputs of step 80. The newly computed yaw rate of step 82 is compared in step 84 with the previously 
calculated yaw rate of step 82 stored in memory during the last scan of the controller 26. K the difference 
between the two yaw rates is greater than a predetermined threshold, the controller 26 exits the routine. 
This ensures that the bank angle computation is not performed during angular accelerations which could 
affect the accuracy of the compulation. Prior to exiting, the newly computed yaw rate of step 82 is stored 

35 into memory at step 88 for reference during the next scan of the controller 26. 

At step 86, the controller 26 computes a vehicle longitudinal velocity in accordance with the average 
wheel speeds. At step 92, the controller 26 identifies the vehicle lateral acceleration sensed by the lateral 
accelerometer 32 corresponding to the input read in step 80. At step 94, the vehicle roll stiffness is 
multiplied by the sensed lateral acceleration of step 92 to arrive at a vehicle roll angle d R . At step 96, the 

40 bank angle e B of the road surface 50 is computed in accordance with equation (8), and filtered to eliminate 
noise. 

The bank angle 6 Q is then stored in memory at step 98 for use by various vehicle control systems to 
improve handling and operation. Prior to exiting, the computed yaw rate of step 82 and longitudinal velocity 
of step 86 are stored in memory in step 90 for reference during the next scan of the controller 26. 

45 

Claims 

1. An apparatus for estimating an incline angle of a road surface upon which a front wheel drive vehicle is 
travelling, the apparatus comprising: 
so a first sensor (22) for providing a first output signal (28) responsive to a rotational speed of a first 

rear wheel (16); 

a second sensor (24) for providing a second output signal (30) responsive to a rotational speed of a 
second rear wheel (18); 

a third sensor (34) for providing a third output signal (40) responsive to a sensed longitudinal 
66 acceleration of the vehicle (10); and 

a controller (26) for processing the first, second and third output signals to arrive at an estimated 
incline angle, the controller comprising: 

means for computing a longitudinal acceleration as a function of the rotational speeds of the first 
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and second rear wheels in accordance with the first and second output signals; 

means for determining a pitch angle of the vehicle as a function of the sensed longitudinal 
acceleration in accordance with the third output signal; and 

means for estimating the road surface incline angle as a function of the computed longitudinal 
acceleration, sensed longitudinal acceleration in accordance with the third output signal and pitch angle. 

The apparatus for estimating an incline angle of a road surface according to Claim 1, the controller 
further comprising a means for storing the estimated road surface incline angle in a memory location 
for use by vehicle control systems to alter vehicle attributes for improved operation and handling. 

The apparatus for estimating an incline angle of a road surface according to Claim 1, further 
comprising: 

means for determining a yaw rate of the vehicle as a function of a difference between the sensed 
rotational speeds of the first and second rear wheels in accordance with the first and second output 
signals, and a distance between the first and second rear wheels; 

means for computing a change in yaw rate over a predetermined time period; and 
means for inhibiting incline angle estimation if the change in yaw rate is greater than a predeter- 
mined threshold. 

The apparatus for estimating an incline angle of a road surface according to Claim 1, wherein the 
means for computing a longitudinal acceleration comprises: 

means for determining an average rotational speed of the first and second rear wheels in 
accordance with the first and second output signals; and 

means for determining a change in the average rotational speed over a predetermined time period. 

The apparatus for estimating an incline angle of a road surface according to Claim 1, wherein the 
incline angle is estimated in accordance with the following function: 

0i = SIN-'fSENSED LONGITUDINAL ACCELERATION - COMPUTED LONGITUDINAL 
30 ACCELERATION - BIASlqnq] - 6 P 

where, 

0i = incline angle, 
Bp = pitch angle, and 
35 BIASlong = a constant. 

6. A method for estimating an incline angle of a road surface upon which a front wheel drive vehicle is 
travelling, the method comprising: 

providing a first output signal (28) responsive to a rotational speed of a first rear wheel (16); 
40 providing a second output signal (30) responsive to a rotational speed of a second rear wheel (18); 

providing a third output signal (40) responsive to a sensed longitudinal acceleration of the vehicle 
(10); 

computing a longitudinal acceleration as a function of the rotational speeds of the first and second 
rear wheels in accordance with the first and second output signals; 
45 determining a pitch angle of the vehicle as a function of the sensed longitudinal acceleration in 

accordance with the third output signal; and 

estimating the road surface incline angle as a function of the computed longitudinal acceleration, 
sensed longitudinal acceleration in accordance with the third output signal and pitch angle. 

so 7. The method for estimating an incline angle of a road surface according to Claim 6, the further 
comprising storing the estimated road surface incline angle in a controller memory location for use by 
vehicle control systems to alter vehicle attributes for improved operation and handling. 

a The method for estimating an incline angle of a road surface according to Claim 6, further comprising: 
55 determining a yaw rate of the vehicle as a function of a difference between the sensed rotational 

speeds of the first and second rear wheels in accordance with the first and second output signals, and 
a distance between the first and second rear wheels; 

computing a change in yaw rate over a predetermined time period; and 
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inhibiting incline angle estimation if the change in yaw rate is greater than a predetermined 
threshold. 

9. Hie method for estimating an incline angle of a road surface according to Claim 6, wherein computing 
a longitudinal acceleration comprises: 

Catermining an average rotational speed of the first and second rear wheels in accordance with the 
first and second output signals; and 

determining a change in the average rotational speed over a predetermined time period. 

10. The method for estimating an incline angle of a road surface according to Claim 6, wherein the incline 
angle is estimated in accordance with the following function: 

0, = SIN~ 1 [SENSED LONGITUDINAL ACCELERATION - COMPUTED LONGITUDINAL 
ACCELERATION - BIASlonqI - *p 

where, 

fl i = incline angle, 
Bp = pitch angle, and 
BIAS lqng = a constant. 

11. An apparatus for estimating a bank angle of a road surface upon which a front wheel drive vehicle is 
travelling, the apparatus comprising: 

a first sensor (22) for providing a first output signal (28) responsive to a rotational speed of a first 
rear wheel (16); 

a second sensor (24) for providing a second output signal (30) responsive to a rotational speed of a 
second rear wheel (18); 

a third sensor (32) for providing a third output signal (38) responsive to a sensed lateral 
acceleration of the vehicle (10); and 

a controller (26) for processing the first, second and third output signals to arrive at an estimated 
bank angle, the controller comprising: 

means for computing a longitudinal velocity as an average of the sensed rotational speeds of the 
first and second rear wheels in accordance with the first and second output signals; 

means for determining a roll angle of the vehicle as a function of the sensed lateral acceleration in 
accordance with the third output signal; 

means for determining a yaw rate of the vehicle as a function of a difference between the sensed 
rotational speeds of the first and second rear wheels in accordance with the first and second output 
signals, and a distance between the first and second rear wheels; and 

means for estimating the road surface bank angle as a function of the computed longitudinal 
velocity, sensed lateral acceleration in accordance with the third output signal, roll angle and yaw rate. 

12. The apparatus for estimating a bank angle of a road surface according to Claim 11, the controller 
further comprising a means for storing the estimated road surface bank angle in a memory location for 
use by vehicle control systems to alter vehicle attributes for improved operation and handling. 

13. The apparatus for estimating a bank angle of a road surface according to Claim 11, further comprising: 

means for computing a change in yaw rate over a predetermined time period; and 
means for inhibiting bank angle estimation if the change in yaw rate is greater than a predeter- 
mined threshold. 

14. The apparatus for estimating a bank angle of a road surface according to Claim 11, wherein the bank 
angle is estimated in accordance with the following function: 

0b = SIN- 1 [$ENSED LATERAL ACCELERATION - (YAW RATE X COMPUTED LONGITUDINAL 

VELOCITY) - BIASlaj] - Or 

where, 

fl B = bank angle, 
0 R = roll angle, and 
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BIASlat = a constant 

15. A method for estimating a bank angle of a road surface upon which a front wheel drive vehicle is 
travelling, the method comprising: 

providing a first output (28) responsive to a rotational speed of a first rear wheel (16); 
« providing a second output (30) responsive to a rotational speed of a second rear wheel (18); 

providing a third output (38) responsive to a sensed lateral acceleration of the vehicle (10); 

computing a longitudinal velocity as an average of the sensed rotational speeds of the first and 
second rear wheels in accordance with the first and second output signals; 

determining a roll angle of the vehicle as a function of the sensed lateral acceleration in accordance 
with the third output signal; 

determining a yaw rate of the vehicle as a function of a difference between the sensed rotational 
speeds of the first and second rear wheels in accordance with the first and second output signals, and 
a distance between the first and second rear wheels; and 

estimating the road surface bank angle as a function of the computed longitudinal velocity, sensed 
lateral acceleration in accordance with the third output signal, roll angle and yaw rate. 

16. The method for estimating a bank angle of a road surface according to Claim 15, further comprising 
storing the estimated road surface bank angle in a controller memory location for use by vehicle control 
systems to alter vehicle attributes for improved handling and operation. 

17. The method for estimating a bank angle of a road surface according to Claim 15, further comprising: 

computing a change in yaw rate over a predetermined time period; and 

inhibiting bank angle estimation rf the change in yaw rate is greater than a predetermined threshold. 

ia The method for estimating a bank angle of a road surface according to Claim 15, wherein the bank 
angle is estimated in accordance with the following function: 

6 B = SIN" 1 [SENSED LATERAL ACCELERATION - (YAW RATE X COMPUTED LONGITUDINAL 

VELOCITY) - BIASlaj] - 0r 

where, 

0b = bank angle, 
e R = roll angle, and 
BIASlat = a constant 
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FIG. 1 
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